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ABSTRACT 


К Бире microprocessor oriented algorithm is developed 
Bemicaentility, track and suppress bending mode signals from a 
control system’s rate and position feedback signals using 
adaptive digital notch filters. The algorithm can be used 
to suppress bending modes having center frequencies as close 
as one octave above the control system gain cross-over fre- 
quency without introduction of the excessive phase loss 
associated with conventional lowpass filtering techniques. 

A third order model of the trident missile autopilot pitch 
attitude control loop is contaminated with two dynamic, 
destabilizing bending modes and used as a concept demonstra- 
tion model. The algorithm is demonstrated by stabilizing 
the pitch attitude loop in the presence of two bending modes 
ПЕ unknown gains, damping, center frequencies and rates 


of change of center frequencies. 
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Vehicle mass in slug 
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I ορος ττον 


The purpose of this thesis is to develop a sımple, micro- 
Processor-oriented scheme that eliminates body bending mode 
ШОО лс ina missile control system by adaptive digital notch 
filtering of the bending mode resonant frequencies from the 
rate and attitude gyro feedback signals. Although this thesis 
πε Trident Fleet Ballistic"Missile as a conceptual 
demonstration model, the process is applicable to many control 
systems having unknown and/or time varying mechanical reso- 


mances. 


A. THE BODY BENDING PROBLEM 

Body bending is a composite term which encompasses the 
line of all structure-borne vibrations from various 
ου. ος into the missile control system through the mechani- 
Cal sensors such as rate gyros and accelerometers. The 
effect of the body bending mode signals in the rate and 
ОШОЛ пае gyro feedback signals is destabilizing since if 
meet ünattenuated, the missile control system tries to com- 
pensate for the sensed body bending rate through the thrust 
vector control (TVC) system thus further exciting the 
bending mode and the inertial or rigid body rates soon be- 
Semen insignificant and go uncorrected. 

Some ot the sources of body bending are: 


1. The missile acting as a cantilevered bean. 





ο... araul ic Servo resonance. 
ο. trueruralsbendıng at the attachment points for 
Draraulic actuators. 

4. Beam-like resonance of sub-assemblies such as 
upper stage motors and payload. 

The body bending problem in missiles is traditionally 
proached in one of three ways: 

1. The mechanical sensors are physically located 
at nulls in the lower frequency bending modes and the 
natural bandwidth of the control system and lowpass filters 
are used to attenuate the higher frequency bending modes. 
Bererence {1} contains a detailed description of the analy- 
sis and testing required to implement this approach in the 
control system of the XSM-65 missile. The popular name, if 
any, of the XSM-65 missile is unknown. 

2. The mechanical sensors are physically located 
at a position in the missile where the deflections due to 
the lower frequency body bending modes are in phase with each 
other, Phase shifting networks are used to ensure that the 
bending mode signals are fed back in such a manner that the 
bending modes are attenuated. Lowpass filters are still 
used to attenuate the higher frequency bending modes. 
Reference [2] contains a general description of how this 
Eod 15 implemented in the control system for the Saturn 


Missile. 
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O ass  oAanadSstap filters are used in the feed- 

EK control loops to attenuate the body bending mode fre- 
wenci es trom the rate and attitude gyro feedback signals. 
A general description of how this method is used in the 
i udentoMissile Control System is contained in Ref. [3]. 

fn the Trident Missile the above three approaches have 
many undesirable features. Location of the sensors at nulls 
or where the body bending modes are in phase requires a very 
precise knowledge of the bending mode characteristics and 
muErTreedom in the initial design to locate the sensors at 
Em anticipated optimum locations. In a solid fuel missile 
35 the Trident, the location of the sensors is pre- 
determined to be located with the other flight control 
HE ronrces with very little latitude to select a null or 
роб оп where the bending modes are in phase. The second 
aor limitation is the lack of precise knowledge of the 
bendzne mode characteristics. The bending mode resonant 
'. ππεῖβθ5. gains, damping and phase are a function of many 
errors ineluding time into the flight, attitude, payload 
Megitieuration, skin temperature, and thrust level. For 
example, the Trident Missile is designed to compensate for 
as much as a twenty-five percent variation in thrust level 
КШ ОШТО Slight variations in the solid propellant mixture and 
Eno while only a three percent ШІ Variation is 
acceptable on the liquid fueled Saturn Missile [2]. Without 


a precise knowledge of the parameters controlling tne bending 


ШІ 





mode resonant frequencies, gains, damping and phase, the 
lowpass and bandstop filters must be designed on a worst 
case basis and as a result reduce the control system band- 
width and phase margins much more than if a narrow notch 
filter had been used at each specific bending mode frequency 
to remove the bending mode component from the rate and 
Position gyro output signals. | 

As the Trident Missile evolves into the next generation, 
the anticipated bending mode frequencies will become much 
lower and approach the natural frequencies of the flight 
control system. The use of conventional lowpass filters 
under these conditions would produce so much phase loss that 


the missile would become unstable. 


ieee THE PROPOSED SOLUTION 

The proposed solution to the bending mode problem is an 
extension of preliminary work done by Lockheed Missiles and 
Space Company [5]. 

If the bending mode resonant frequencies can be deter- 
mined in near real time during the flight and tracked as 
EIT controlling parameters change, then adaptive notch 
digital filters in the rate and position gyro signal feed- 
back paths can be implemented to attenuate a selected number 
of bending mode signals that are contaminating the desired 


rigid body rate and attitude signals. 
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The difficulty in the implementation of such a solution 
lies in the in-flisht determination of the bending mode 
frequencies rapidly and with sufficient accuracy. The rapid 
determination of the bending mode frequencies is essential 
in order to place the notch filter at the proper bending 
mode frequency before the bending mode signals can degrade 
the missile attitude and rates to a point from which it 
Samet recover within the allowable flight trajectory 
envelope. The allowable time for the initial determination 
Of the bending mode frequencies is a function of the initial 
frequency and bandwidth of the individual notch filters. 

In general the time available to eliminate the effects of 
the bending modes before the Trident Missile deviates from 
Euwceceptable flight trajectory is one-half second. The 
requirement for accuracy is essential to allow the minimum 
bandwidth notch filters to be used. As successive notch 
lE ters are added to the control system to attenuate the 
bending mode signals, an increasing amount of phase loss 
will be experienced at the frequencies used by the control 
System resulting in a decrease in the already minimal phase 
cn or overall missile stability. If very narrow notch 
filters are used to minimize the phase loss at the control 
system frequencies, then the center frequency of the notch 


must be placed much more accurately to be effective. 
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Dome choc еее оа Сеа as to their potential to 
De used for inflisht bending mode frequency identification 
End tracking: 

1. Reference [3] summarizes the use of Fourier 
integral filters to measure the power spectral density at 
Integer frequencies. Second order curve fitting techniques 
were then used to estimate the bending mode frequencies 
mol the output of the filters. The major drawback of this 
Annique is that it required at least one-half second of 
integration time for each repeated frequency determination. 
Memerence [3] did not address the ability of this technique 
accurately track a dynamic bending mode, although the 
data indicated that a bending mode that was changing as 
Maple as 0.2 hertz per second would cause sufficient dis- 
tortion of the frequency determination as to render the 
technique ineffective. 

БЕ ihe author conducted a feasibility study of 
using a Fast Fourier Transform (FFT) algorithm to determine 
m@emspectrum of the rate gyro output signal in order to 
determine the bending mode frequencies. The method was 
disregarded for two reasons. The rate gyro signal would 
have to be sampled for ten seconds to obtain a minimum 
frequency resolution of 0.1 hertz and, the computational 
ο τν required to execute the FFT algorithm was felt 


to be excessive. 
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E C οποτε οἱ USING a4 pnaselock loop to 
lock-on and track a bending mode frequency was investigated 
Berne author. Simulation of a phaselock loop with an eight- 
Bertz center frequency and a three-hertz acquisition range 
revealed that while the tracking characteristics of the 
pusselock loop were very good, the ability to achieve lock 
with a random phase signal at the extremes of its acquisition 
ШОП сс was unreliable if the signal was contaminated with fre- 
quency components from the plant and a second bending mode 
Uuuticiapted signal levels. The technique was not pursued 
further but with the addition of prefilters on the phase- 
lock loop input this technique has the potential to be more 
effective than the technique used in this thesis. Consi- 
ible refinement in the simulation of the phaselock loop 
nonlinearities would be required. 

4. The technique used in this thesis to identify 
ο track the bending mode frequencies uses a microprocessor 
E Compute the frequency Of each bending mode by use of 
ο iltal bandpass filters and linear estimation of the zero 
Crossing times. The use of discrete signal processing by 
ES microprocessor will not require additional sampling 
EEXCHTtry since the missile attitude and rate gyro signals 
@ue Currently sampled and put in digital form in the Trident 
Sile for use in the digital autopilot. As shown in 
Mire 1-1, the microprocessor uses the sampled rate gyro 


faa by passing it through a set of parallel digital 
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ο 11565 іп Order to decompose the signal into Íre- 
mney bandas that are only wide enough to contain one 
Bending mode frequency. The output of each of the bandpass 
Hostal filters is examined after each sample to see if the 
Etude Of the signal in that band has changed signs. If 
miewanplitude has changed signs then the time of the zero 
crossing is linearly estimated based on the amplitude of the 
Signal before and after the zero crossing and the sampling 
τοι, The half period detected is converted to a fre- 
ΠΕ: and averaged with the frequency that the digital 
En otrlter devoted to that band is currently tracking. 

The average of the current and computed frequency is then 
used to compute new coefficients such that the digital notch 
filter will be centered at the new average frequency. The 
details of the algorithm and design are discussed in Chapter 
Mee and the concept is demonstrated by simulation in 


Chapter Four. 
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О ТОЕ ЕЕЕ О РИМЕ 


Imsorder to verify the ability of the tracking notch 
filter concept to stabilize the missile in the presence of 
bending mode feedback, a model of the system was developed 


Robe used as the basis for simulation. 


ЖЕР ІНЕ MODEL OF THE PLANT 

Sıeure 2-1 15 a block diagram representation of the re- 
reed Order pitch plane attitude control loop of the Trident 
I Missile autopilot. The model was provided by Lockheed 
Bussrle and Space Company by reference [3], and was modified 
Pietro the extent that the signs at the summers for κ and 
х. Miec hanged to allow all the model coefficients to be 
considered positive quantities. Table 2-1 shows the time 
Du unge values for the parameters used in this model. The 
Medel shown in Figure 2-1 represents the rigid body dyna- 
mics of the missile and is referred to as the plant. When 
pendine modes are added to the rigid body model the resulting 
composite model is referred to as the system. 

The state space representation of the plant for any time 


m 


- -K.M.X, - M.X4-M X,-K.N 
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Figure 2-1 Pitch Plane Attitude Control Loop 
(Plant) 


LS, 





PAB bE. 2 > 1 


e AEREA METER VALUES AT VARIOUS TIMES INTO THE FLIGHT 


PARAMETER I225 SEC IU SEC. EU SEC.: 
M, ον» 246.560 7:5 1725 
М, Do Í 24.17 52700 
Zo, 88.87 00 140.0 
2, ЕСЕН ΤΙ» ση. 5 
γ 7250 2500 5400 
p. 0209 0.06 0.06 
РР Tr 0 GG oo 2 
Yon 0.06 5 ουσ Ш 2015 
Ko > 1.48 0.946 
K 2 02 0.2 
r9 
ЖЕНЕ: The units of each parameter are listed on the list 


of symbols. The signs of the parameters are all 
positive to be consistent with the structure of the 


model used. 





where: 


where 


= x E. DAD NES. 
E EU e зе, 
V V V ۷ 


тепе тте етте pitch angle. 
ШЕ πε ΠΙςσςσι]ε pitch angle таге. 


πο ρε amele of attack. 


Шарт посастоп thesplant is then described by: 


= AX + BO 
مہ مہ‎ e 
т С 
| ϱ 1 0 | 
= - A = M З 
A K¿M, К КМ М 
ES zz 
y v v 
i5 BURNS ONE SNB 
- 978 0-5 
V 
С = (ША Ὁ. 3] 





D -acccnsreresunetron relating the missile pitch angle 


9 to the commanded pitch angle ge 15: 


Ө (5) 
= H(s) 


9.5) 


-K, [MS * (MZ, -M,2,)] 
DEAE. 
; | 
N $ INN Ne V [2.7 τν 
5 + (Сак К. M.)s +[M +K oK g2, M Zs)+K.M.]s+K. (M,Z -M Z) 
y qo m ү V 


H(s) = 


(1) 


Mice transter function can be factored with a root finder 
Ed to plot the poles and zeros of the transfer function 
in order to provide an intuitive feeling as to the response 
of the system not otherwise apparent with the state-space 
mepresentation. The state-space representation of the sys- 
tem is used primarily in the simulation programs to obtain 
E time domain solution to the differential equations of 


motion. 


ШЕРТПЕ CHARACTERISTICS OF THE PLANT 

ET model OE the plant given in Figure 2-1 is a model of 
the rigid body dynamics including two Newtonian integrators 
СИС Ее positive feedback of the angle of attack, x., The 


5 


22 





output pitch angle Ө is opposite in sign to the commanded 
patch Ie: Ше Теуегса! 15 Compensated for in the outer 
ИЕ nce loop not included in this model. The sign of the 
forward gains М, апа 22 are normally specified as negatıve 
Amentities which results in a net negative feedback. For 
Sompucational convenience the gains are treated as positive 
quantities and the signs at the summers have been changed. 
ШШЕ s ion of the rate and position feedback summers remains 
Positive to clearly indicate the nature of the positive 
feedback of the bending modes from the pitch rate and pitch 
angle gyros. 

The model of the plant was designed с ш the 
transient behavior of the system and not the steady state 
behavior. As a result the sımulation studies are only valid 
for about two seconds of transient behavior. 

establish a baseline Or nominal performance the plant 
Was Simulated for a ramp and a step input with system para- 
Meter Values fixed at the time = 40 second values. The 
reasoning behind the selection of inputs and parameter values 
memarscussed in Chapter Four. 

selecting the appropriate values for the system para- 
meters from Table 2-1 for time = 40 seconds, the transfer 
function, given by equation (1) becomes: 

ο 7 (St 0) 01779) 


H(s) = AA — (2) 
($+0.0098)(s+3.608+/-J 7.17) 
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Mempo Tes anda zeros Of the transfer function are plotted 
ШІ Еіспге 2-2. 

An examination of the poles and zeros of the transfer 
EBimerıon indicates the system is stable with a pair of com- 
plex poles having a natural frequency DE = ο ο ο SEC and 
EEcoetfricient of damping ἔ Ξ 0.449. There is also a very 
slow pole at s = -0.0098 and a 2 о (0 01779. 

To establish the baseline or nominal performance of the 
plant without bending modes, the plant was simulated using 
the IBM DSL/360 language. The values of the plant para- 
meters from Table 2-1 for time = 40 seconds are used through- 
[τι thesis. A detailed discussion of the simulation 
programs and the selection of the plant parameter values is 
contained in Caneel IOUT AFi gure 2-5 illustrates the plant 
Er ponse to a step input pitch command of 0.1 radians. 
Escure 2-4 illustrates the response of the plant to a ramp 
Pat of 0.05 radians/sec. 

fore: It will be the Convention in this thesis when 
presenting computer generated output in the form of a figure 
to include the computer program that was used to generate 
that figure in the computer program appendix properly 
labelled to indicate the figure number. If reference is 
made to the program it will be referred to as program 


(figure number). 
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Figure 2-4 Missile response for a ramp command 
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oia li Баса стопе іп this thesis are performed 
ЕПС the third-order model of the plant, it is possible to 
reduce the model to a second-order model without introducing 
Meer icant error. The second-order model provides a con- 
venient preliminary design model since the characteristics 
of second-order systems are well established. The second- 
order model is derived by analysis Е the time domain res- 
ponse of the third-order system and eliminating the effects 
Ehe slow pole and zero. The validity of the second- 
order model is established by comparison withthe third-order 
model simulation results, 

obtain the time domain response to a 0.1 radian step 
mapuc the transfer function of equation (2) will be multi- 
plied by 0.1/s and the resulting function expanded in a 
partial fraction expansion. 

0.1 307250800779) 


9(5) = O a - 
5 s(s+0.0098) (s+3.608+/-J 7.17) 





which yields: 


-0.0098t SO USE 
eat) = -0.1+0.0453 e ο nO ue CAS Ee d 55) 
at te = 7.0 sec. 
ЕЕ) - (.І + 0.0453(0.98) + 0.06218(0.00072)C0S(14.34-0.455) 


iS 52 


28 





Каи оир 6 time domain response one finds that the 
influence of the slow pole is so slow that one may consider 
mieeresponse of the system due to that pole to be essentially 
constant for the two second duration of the simulation with 
Tess than two percent error. Treating the term due to the 


Sew pose aS a constant reduces the time-domain solution to: 


οὐδε 
ПО = 20.0547 + 0.06218e ος -= 02453) (57) 


The system now can be considered as second-order and the 
ee ponse can be very closely approximated from tabulations 
πε Characteristics of second order systems [4]. 

lu c transform of equation (3) 15 


Ms == ОУ) 
E27 972022: 61.4265 


+ 


L[e(t)]»s(s)e = 


Placing all terms over a common denominator: 


2 2 
a(s) = mum eo 0957 S0. 524 1 0,05589.5$ -+0.3967 5 
20 5161.4205) 


Mancelling the essentially equal . andas Серпе IN the 
Eu Er2tor and factoring out the transform of the 0.1 radian 
EX 3nput (0.1/s) yields the following reduced order trans- 
Bemertunction relating the missile pitch angle 6 to the 


Semmanded pitch angle 9 


0(s) i 5521 2 
Ευ E (3a) 
жер r ο ο - 64.4265 
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Ио шолу State gain of the system is: 


5 Н (5) 
LIM — =-0.547 


5-0 5 
The peak overshoot will be: 


τς 


ΛΠ ο η εἰ = 1-21 


The time of peak overshoot will be 


{_ = 0,458 ѕес 


The validity of the second-order model for a ramp input 
Momeotablished by comparison of the value of the missile 
MEN angle determined analytically from the second-order 
transfer function at time = 2 seconds with the value resulting 
ШОШ the simulation of the third-order plant. 

ven a transfer function in the form: 


BS TDS E + DES 


0 1 
BE) - 





NINE Ready state Lime demain response of the output to a 
mmo input, u(t) = at, can be determined from the following 


fmormuia [5]: 


B. A A 


eee) = — at + 


А, А2 


0 


Meme the second-order transfer function determined in 
equation (3a) one finds that the output at time=2 for a ramp 
Bape, u(t) = 0.05t is: 

oe 4100.05) t Omi ot soa24 2260) 


9 (t) = ---------- A 1 11-277) 
Р 64.4265 (64.4265) 


Table 2-2 summarizes the results obtained from the second- 
SI model with those resulting from simulation of the third- 
order model. Again, it must be noted that the simulation 
Лас е5 contained in this thesis were performed using the 
third-order model of the plant. The second-order model was 
derived only as a convenient preliminary design tool for any 


subsequent studies. 





TOBLER: 


COMPARISON OF THIRD-ORDER AND SECOND-ORDER MODEL RESPONSES 


BENRACTERISTIC SECOND - TH PRD- 
ORDER ORDER 
MODEL SIMULATION 
MAXIMUM 
OVERSHOOT ыл J 1 
TIME AT MAX. 
OVERSHOOT 0.44 SEC ο ο. Ες 


ΓΙΟΥ 5ΤΑΤΕ 





GAIN -0.5625 -0.547 
SETTLING 

TIME (23) ШІНШІ СЕС ЕС 
RAMP OUTPUT 

ENET-2 SEC -0.0524 -0.0526 
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ΗΕ MODEL OF THE BENDING MODES 

Reference [3] provided the model of the plant with one 
bending mode shown in Figure 2-5. The bending mode attitude 
Signal X4 and bending mode rate signal х- аге add ο ους 
τὰ body attitude signal Xi and rigid body rate signal х, 
respectively. The composite attitude and rate signals аге 
each fed back to the system input in a positive sense and 
the overall system becomes highly unstable. 

Reference [2] states that the bending mode contamination 
meee rigid body rate signal has a much greater destabilizing 
τετ than does the bending mode contamination of the rigid 
body attitude signal. The bending mode model is therefore 
based on modeling the bending mode rate and the bending mode 
E Uude signal is formed by integrating the rate signal. 

Reference [6] contains the bending mode frequency res- 
ponse for a Poseidon Missile when the bending modes were 
mE by slewing the first stage TVC nozzles. Although 
the data was measured on the Poseidon Missile with various 
ШЕСПТ configurations, the results are consistent with the 
SEI distribution of bending modes shown in Figure 3.3-1 
Of Ref. [2]. The distribution of the bending modes indicates 
that the bandwidth of the bending modes increases as the 
Er Frequency of the bending mode increases. The distri- 
bution of the bending modes used in this thesis is shown in 
Figure 2-6. The low frequency bending mode may be centered 


anywhere in a band from 5 to 8 hertz and the high frequency 
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bending mode may be centered anywhere in the band from 8 to 
15 hertz. The high frequency bending mode has approximately 
ісе the bandwidth of the low frequency bending mode. The 
mulation studies contained in Chapter Four demonstrate the 
E Of the adaptive notch filtering scheme to identify, 
Eck and filter bending modes that have time varying gains, 
Emwidths and center frequencies. 

ine bending mode rates were modeled as the outputs of 
mass filters with a very hich Q. The transfer function 
Bing the output Y(s) to the input U(s) for a general 


end order bandpass filter 15: 


Bs 
ES) = 
2 ο ο ο : 
Е 
where: 
a = tlhe cehter frequency of the filter 
LEN - the 5 dB bandwidth of the filter 


ШОО ОС diagram of G(s) 1S shown in Figure 2-7.  Y(s) 
maae sents the bending mode rate output and since the bending 
mode attitude output is the integral of the bending mode rate, 
Eput of the bending mode attitude is also available from 
the rate model as indicated in Figure 2-8 where Υ1{5) is the 
bending mode rate output and Y,(s) is the bending mode atti- 


Bude output. 





Figure 2-7 





Bending Mode Rate Model 
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Bending Mode Rate and Attitude Model 
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in ns tron so: Figure 2-8 reveals that modeling the 
Memaing mode rate as a bandpass filter is equivalent to the 
bending mode model shown in Figure 2-5. 

Figure 2-9 shows the system model consisting of the plant 
and two bending modes that are used for the simulation 


Eudres in this thesis. 


Dee CHARACTERISTICS OF THE PLANT WITH TWO BENDING MODES 
Preliminary values for the bending mode parameters of gain, 
center frequency and bandwidth were selected for the purposes 
@ieanalysis and to develop some insight as to the elements 
ontrolling the behavior of the system. The bending mode 
parameters are varied during the simulation studies presen- 
ted in Chapter Four but the detailed analysis is not repeated 
for each parameter study. 
The bending mode parameters selected for analysis of the 


system are: 


Gp = 20.0 

В, E IO RAD/SEC 

Wr ОЛ ου RAD/SEC (10 Hz center frequency) 
Gy = 240.0 

By = 0.1 RAD/SEC 

D. - RA SECO Ez center frequency) 


mire trequency response of the transfer function relating 
Pre missile pitch angle 6(s) to the input pitch command в) 


with the rate and attitude feedback loops open was determined 
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Model of Plant with Two Bending Modes 


Eure 2-9 
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for various configurations of the plant and bending modes 


Shown in Figure 2-9. The plant parameters from Table 2-1 


for time = 40 seconds were used. 

Figure 2-10 shows the open loop 
plant with no bending modes. 

Figure 2-11 shows the open loop 
6.0 Hz bending mode alone. 

Figure 2-12 shows the open loop 
plant and the 6.0 Hz bending mode. 

Fagure 2-15 shows the open loop 
UO Hz bending mode alone. 

Figure 2-14 shows the open loop 
pnt and the 10.0 Hz bending mode. 


Figure 2-15 shows the open loop 


frequency response 


frequency response 


regu ney response 


frequency response 


frequency response 


frequency response 


Of 


of 


ОЕ 


ОГ 


ο. 


of 


plant with both the 6.0 Hz and the 10.0 Hz bending modes. 


the 


the 


the 


the 


the 


the 


lhe matrix representation of the state equations derived 


from the closed loop system shown in Figure 2-9 is: 


w= Ax + BO 

E "eh an € 

О = Cx 
where: 


TS the rigid body pitch angle of the missile 


15 the rigid body pitch rate of the missile 


Beis the missile angle of attack 


Xy 1S πο pitch angle resulting from the lower frequency 


bending mode 
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bending mode 


ШОШО ЛО DILEN апп те resulting from the higher fre- 
quency bending mode 


is the pitch rate resulting from the higher frequency 
bending mode 


is the commanded pitch angle 


Watne missile pitch angle 


A matrix is: 


Al2 А15 А14 А15 А16 А17 


А22 AZo A24 A25 A26 A27 


А52 А33 A34 ASS A36 A37 


A42 A4 3 A44 А45 А46 А47 
А52 А53 А54 A55 А56 A57 
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A72 A73 A74 А75 А76 p 
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Bee Bee Bo 57! 
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where: 


Bl 


Al2 = 


А135 


А14 


А15 = 


Al6 = 


А17 = 


А41 = 


A42 = 


A43 = 


А44 = 


A45 - 


A46 = 


A47 - 


А71 = 


А72 = 


А21 
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For the bending mode parameters selected and the plant 
parameters for time = 40 seconds the transfer function H(s) 
15: 

E 5) _34.97(s+48.4) (s-48.7)(s+0.018) (s+0.215+/-j48.65) 


ЕБ). (s+0.01 ο ος] 
ο ο 02 25) 












p 





uU XuStrer function H(s) was factored using the "roots' 
E rum contained in Ref. [7]. The location of the poles was 
Bonfırmed by finding the eigenvalues of the A matrix using 
С "ВАЗ5МАТ" program also contained in Ref. [7]. The poles 
Me ros of H(s) are plotted in Figure 2-16. 

The system composed of the plant plus bending modes is 
@eearly unstable with four poles of the closed loop transfer 
melon in the right half of the S-plane. 

Figure 2-17 shows the simulation the system shown in 
EE: 77-9 for a step input of 0.1 radians. Line 1 of 
Mmeoure 2-17 is the response of the plant without bending 
modes and line 2 is the response of the system composed of 
lant with bending modes. The vertical scaling in Figure 
2-17 was restricted to keep the response of the plant in 
БЕТ perspective. The restriction of the vertical scale 
meres Saturation of the plot of the system response (line 2). 
Figure 2-18 shows the response of the system with the verti- 
Gat scale extended to remove the effects of saturation of 
ET plot. For clarity, the response of the plant without 
bending modes was not included in Figure 2-18. 

To validate the simulation, the time response of the 
ο. CQuations with a 0.1 radian step input was determined 
КОШСО їс the "RTRESP'" program contained in Ref. [7]. The 
Pitch angle of the missile, 0 was found to be described by 


Mefeguation: 
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Figure 2-17 Missile Response with Two Bending Modes 
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ους 


a(t) = -0.09952 + 0.0457 e 
ο ο ο ορ С сук о її) 
ғ 0.00246 е3:34" со5(38.15%-2.45) 
к 0.00095 е:71% cos(62.25t+3.06) 
At time = 1.0 seconds, the above equation indicates the 
 ЕСП апс1е will be 0(1) = -0.10162 radians. The numerical 


results of the simulation used to generate Figure 2-17 indi- 

eate the pitch angle to be 9(1) = -0.1017 radians. The 

preceeding results indicate the simulation program is valid. 
The system was simulated with only the high frequency 

bending mode and with only the low frequency bending mode. 

The purpose of these simulations was to show that each bending 

mode would by itself destabilize the system and that the fre- 

υπο of the oscillation of the resulting unstable system 

Would reflect. very nearly the center frequency of the 

bending mode that destabilized the system. Figure 2-19 illus- 

trates the response of the system for a 0.1 radian step 

input when only the high frequency bending mode was present. 

Figure 2-20 shows the same simulation with an expanded verti- 

cal scale. Figure 2-21 shows the response of the system for 

a 0.l radian step input with only the low frequency bending 

mode present. Figure 2-22 shows the same simulation with 

an expanded vertical scale. Figure 2-23 shows the system 

response with both bending modes for a ramp input 


3 c (t) = 0.05t. 
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Figure 2-21 Missile Response with 6 Hz Bending Mode 
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ΠΕ 1 IS chroush 2-22 clearly indicate that each 
bendins mode is in itself destabilizing. Analysis of the 
numerical data associated with Figures 2-19 throush 2-22 
confirms that the frequency of the oscillations is essen- 


tially at the frequency of the bending mode center frequency. 
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OP ERECTA FILTER DESIGN 


ШІ FACTORS AFFECTING THE DESIGN 

ШЕВ emphasis of the design was simplicity. Significant 
improvement in the results could have been achieved by use 
ENbssher order filters and by using more sophisticated fil- 
Mets, but the improved performance would have been accom- 
plished at the expense of obscuring the very simplicity which 
Mees che proposed technique so appealing. 

The sampling frequency used throughout this thesis is 100 
Mertz. This selection is dictated by the sampling frequency 
ИШЕСЕ Бу the autopilot in the Trident Missile. Higher sam- 
pling frequencies were found not to significantly improve 
the performance of the algorithm, however, sampling fre- 
Miéncles lower than 60 Hz deeraded the aleorithm to where 
it would not perform reliably. 

The bending mode frequencies were selected such that one 
and only one bending mode would be in each of the bands of 
u rc; and 8-12 hertz as shown in Figure 2-6. A priori 
knowledge of the band or range of frequencies over which a 
given bending mode may vary during the flight of the missile 
is essential in this design. If specific events during the 
flight such as staging change the bands of the bending modes 
then the algorithm may also be modified to adapt to the new 


distribution with the only requirement being that the times 
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or events which change the band limitations be preprogrammed 


in the microprocessor algorithm. 


B. DESIGN OF THE ALGORITHM MODULES 

Figure 3-1 shows the modular nature of the algorithm for 
ШЕ Песетпіпасіоп, tracking and notch filtering of the bending 
mode signals. The sequence of modules associated with the 
EE mnation, tracking and notch filtering for each of the 
bending modes are collectively termed a channel. The channels 
E Ent ical except for the numerical values of the coeffi- 
EMSuts. therefore, only the design of the 8-12 hertz (high) 
ΠΕ is presented in detail. Ne TEeSuUIES O themes. on 
of each of the modules comprising the low channel are pre- 
sented when different from the corresponding module in the 
high channel. 

ES Ihe Bandpass Filter Module 

The overall bandpass filter was designed as two 
ШЕШ Шеп Second-order bandpass sections. The first section 
15 a first-order Butterworth lowpass Filter transformed into 
a bandpass filter and then transformed into the z-domain 
using the bilinear transformation. The second section is 
also a bandpass filter designed to adjust the overall shape 
of the gain curve to the desired form. 
A first-order Butterworth lowpass Filter normalized 

Р СПИСОГГІ frequency of 1 radian/second has a transfer 


aCtion: 
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1 
s + 1 





Hi p (s) = 


The transformation from lowpass to bandpass is: 


s^ EE. 2 
E 


Bs 


where: 


Bis the 3 dB bandwidth defined as ШЕ - Wee 


W_ is the center frequency defined as y W.W. 
D. is the upper 3 dB frequency in rad/sec and Nr is the 
lower 3 dB frequency in rad/sec. | 
The resulting analog domain transfer function for 


The Dandpass filter is: 


Hap(s) = a τὸ (4) 
s bs et Wave 


Petore applying the DbDilinear transformation to trans- 
form the analog bandpass filter to the discrete domain it 
is necessary to prewarp the center frequency ne [8]. The 
Euarping is done by using the following transformation: 


SIT 
2 TAN (53) 
ЧА — i, (5) 
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where: 


О is the desired discrete or digital frequency defined 


a5. 


T is the sampling frequency. 


/2 


W. EN nc analog center frequency defined as N= (Wy, )! 


БЕС с лет бас Ee Ісиет Cutoff frequency and 
E hertz as the upper cutoff frequency. The values to be 


used in equations (4) and (5) become: 


W. = 27°8.0 = 50.265 rad/sec 


L 
Wa 20290-12.0 - 75.398 rad/sec 
b Са ° 
We (WW) 61.652 rad/sec 
B = ie = 25.133 rad/sec 


Applying equation (5) with the selected value of We 


yield the prewarped center frequency: 


Wa = 63.582 rad/sec 


Substituting the above value, equation (4) becomes: 


ISS S 


AE 
πλ 150 15595 FE 4042.77 


(6) 
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I SDI]; ear transformation for the s-domain to the 


z-domain is: 


μυ πα che transformation to equation (6), the dis- 
ЕГЕ transfer function for the bandpass filter becomes: 


οι 
A. AAA 
EU og cp odq:05 
ArterssjTcht adjustments to obtain thè desired gain 
E Crossover frequency with the low frequency channel band- 
ЕС ilter (see Figure 3-9), the transfer function H, (2) mss 
(RT e - 1) 


HZ) —— t O 
Е-Е 50257775 0:81 


The pole and zero configuration of H. (Z) is shown in 
Ereure 3-2 and the frequency response of H (2) is shown in 
Eure 5-5. 

КЕ сс е  requency response of H, (2) 15.22.00 
flat to provide the needed stopband attenuation for the 
cent channels. The frequency response of the overall 
bandpass filter is greatly improved by adding a second sec- 
tion of filter with a sharp resonant peak at the center fre- 
quency. A bandpass filter with the desired resonant peak 
Seemeaesigned directly in the z-domain using a digital filter 
frequency response program (program 3-5) to adjust the poles 
and zeros to obtain the desired characteristics. The trans- 
Memerumction of the second filter section is: 


3 
Peres 6225 05809 Z 0.25) 

H, (2) 
"MEE 27 0.7225 
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The pole and zero configuration of H, (2) is shown in 
Eure 5-4. The frequency response of H, (Z) is shown in 
iure 5-5. 

Figure 3-6 shows the flow graph of the algorithm for 
the implementation of the two cascaded sections and Figure 
3-7 shows the resulting frequency response of the cascaded 
sections. 

Figure 3-8 shows the frequency response of the low 
channel bandpass filter designed in the same manner. Figure 
9-9 illustrates the resulting band coverage of each channel. 

The possibility of a bending mode occurring at the 
€ight-hertz cross-over frequency between channels causing 
both channels to lock on that frequency and leaving one bend- 
ing mode unattenuated is compensated for by initializing both 
notch filters at the cross-over frequency, thereby attenuat- 
ing a bending mode at eight-hertz immediately and freeing 
either channel to track and remove the unattenuated bending 
mode. 

lee ihe Zero Crossing Detector Module 

Meme nome ross ana daetector 1s based on a linear 
u Ce of the crossing time if the amplitude of the output 
of the bandpass filter changes signs between samples. Linear 
estimation of the crossing time is a feature incorporated 
mS the digital simulation language program (DSL) as the 
cross function but could also be programmed using the 


algorithm shown in Figure 3-10. The potential for using 


1 
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a sinusoidal curve estimation rather than a linear estima- 
tion was considered and dismissed because any increase in 
the accuracy of the estimate of the zero crossing time was 
offset by the jitter in the actual crossing time caused 

by leakage into the channel of the adjacent bending mode and 
mont frequencies. 

INE Major deflicleney ihn tle use Of 34 ZeTO Crossing 
detector as a frequency measuring device is the nonlinear 
error in the frequency estimate as a function of the actual 
frequency. For example, if the frequency being measured is 
Seo hertz the half-period measured should be 0.1 seconds. 

If noise caused a 0.01 second measurement error and the 
measured half-period was 0.09 seconds then the frequency 
detector would estimate the input frequency to be 5.55 hertz. 
Ene input frequency was 10.0 hertz the same 0.01 second 
error would result in an estimate of the input frequency of 
S hertz, a five times greater error for the same measure- 
ent error. 

The effect of the nonlinear quality of the estimated 
frequency in the presence of noise causes a much greater 
Variation in the estimate of the higher frequency bending 
modes and contributes to the limit cycle problem described 
below. 

3. The Frequency Averaging Module 
The primary source of limit cycle behavior in the 


tracking algorithm appears to be due to leakage of an 
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ΙΙ πε bending mode frequency into the zero crossing detec- 
 Сапсіпс a periodic error in the frequency determination. 
The frequency averaging module simply determines the mean 

of the last detected frequency from the frequency detector 
and the current notch filter center frequency. The mean of 
the two frequencies becomes the new notch filter center fre- 
EY The process of averaging the last detected frequency 
πο current notch filter center frequency reduces the 
amplitude of the limit cycle but does not eliminate it. To 
ET reduce the amplitude of the limit cycle, several 
approaches may be taken: 

(a) Greatly improve the stopband attenuation and roll- 
wî Characteristics of the bandpass filters. This approach 
1s discussed insenesconelussons contained in Chapter Five. 

(b) Average the detected frequency over a sufficient 
Ember Of zero crossings before moving the notch. This 
approach was found to significantly reduce the amplitude of 
the limit cycle but was so slow in moving the notch to the 
correct frequency that the bending modes would increase to 
such an amplitude that the missile would be destroyed 

A. Design of the Notch Filter Module 

The design of a discrete notch filter and the calcu- 
meen Of the coefficients is simple and efficient. Figure 
3-11 illustrates the pole and zero location of a second- 
order notch filter on the Z-plane. Since the zero is 
located on the unit circle, the center frequency pa of the 


notch is completely specified by the angle Qe 
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The angle 2 ШОО оте то аз the discrete fre- 
quency and is defined as the angle from the positive real 


Eus to the zero such that: 


where: 
i is the desired notch center frequency in rad/sec 
Ш 15 the sampling period in seconds 
ime ποσα σι Of the zero ON tne Unit circle at a 
elected discrete frequency, Qe ensures that the center 
Sethe notch will be at the desired frequency completely 
independent of the selected location of the poles. The loca- 
tion of the poles on the same radial (discrete frequency) 
as the zero maintains the approximate symmetry of the notch. 
The radius of the poles determines the bandwidth of the 
En. The closer the poles are to the unit circle, the 
Marrower the notch will be and the longer the settling time. 
The transfer function Hy (2) ο; πε ποτε} filter is 
Ее form: 


G(z* - Al Z +1) 


Hy (2) = 
Z - Bl Zt B2 


where the coefficients are defined by the following formulas: 


Al = 2 cos (К.Т) 
MS r cos (WT) 

р c 
bee = T 2 


р 
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το is the radius of the poles 
|. is the desired center frequency of the notch in rad/sec 
Gers the gain 


For unity DC gain H(Z)|Z=+1=1 yields the formula 


ΙΙΙ 5: 


HE 7 —- AT 


у 


The relationship between the pole radius and the 3 dB 
Bandwidth of the notch filter is a function of center fre- 
quency but can be approximated by making certain simplifying 
assumptions. Figure 3-12 shows the geometry on the unit 
Circle when the discrete frequency, W.T is at the 3 dB 


D 
ЕСЕТ frequency. The gain at the cutoff frequency is: 


ERE pL - 9.297 (7) 


In this application it is reasonable to assume that 


[25 |* [P], the poles are close to the unit circle, and the 


bandwidth of the filter is small (W_T-WpT). With the above 


assumptions, equation (7) then reduces to: 


@ = + 2 8.9 (8) 
1 


Using the pythagorean theorem and substituting zt 


2 
0.5 51 


Found: 


Сое ыа шеп {6} the following relationship can be 
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e - 2) e (9) 


For small angles the cord can be assumed to be equal 


mothe ARC length, therefore: 


ΙΤ WT =| 0-5 B85 = 0-5 847 (10) 


where: 
By wt he discrete bandwidth in rad 
В, is the analog bandwidth in rad/sec 


Sübsertutins equation (10) into equation (9) and 


solving for B,, yields the approximate relationship between 


W 
Mmeeenotch filter analog frequency bandwidth and the pole 


Eus in the discrete domain. 


ANT) 
KL rn- (EU 

The numerical data associated with the frequency 
response curves for the notch filters indicates that equation 
(11) yields bandwidths that are larger than the desired 
bandwidths but the error is less than 10 percent in the 
EsEguency range of 5 to 15 hertz. 

Figure 3-13 shows the gain vs frequency response of 
the low channel notch filter with a center frequency of 6.0 


E апа а ро1е radius of 0.9. This configuration has a 
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ШИЕ Бапамісеһ of 2.95 hertz. Figure 3-14 shows the phase 
vs frequency response of the same notch filter. 

Figure 3-15 shows the gain vs frequency response of 
KUU ih channel notch filter with a center frequency of 
meme hertz and a pole radius of 0.8. This configuration has 
a 3 dB bandwidth of 5.9 hertz. Figure 3-16 shows the phase 
vs frequency response of the same notch. 

The argument used to create Figure 2-6 established 
that the higher of the two bending modes would have a wider 
bandwidth than the lower frequency bending mode, therefore 
the bandwidth of the notch filter for the high channel was 
ШОШ леа to be wider than the low channel. There is a limit 
to which the notch bandwidth can be increased without in- 
ducing excessive phase loss at the plant operating frequency 
I VO hertz. For the notch bandwidths used in this algorithm 
the high channel, with the notch centered at 10.0 hertz, in- 
troduces a phase loss of 7.75 degrees at two-hertz and the 
low channel, with the notch centered at 6.0 hertz, intro- 
duces a phase loss of 11.0 degrees at two-hertz. The com- 
bined phase loss introduced by the notch filters used in 
this algorithm does not have a pronounced effect on the 
Stability of the plant. 

eee Flow Chart of the Algorithm 

АЕО provides a flow chart of the entire 

algorithm. The "prime time" computations are the processing 


of the error signal and outputting the filtered value to the 
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autopilot with minimum processing delay. The "slack time" 
computations are the computations performed after the error 
signal has been processed and which do not introduce pro- 
cessing delay in the control system. With a 100 hertz 
sampling frequency, sufficient time should be available to 
Bomplete all slack time calculations every cycle, with 


mr ently available microprocessors. 


BEST OF THE ALGORITHM 

The algorithm was first tested as shown in Figure 3-18. 
An input signal consisting of the sum of equal amplitude 
2.0, 6.0 and 10.0 hertz sine waves initially in phase was 
ШЕП То simulate the rate gyro output signal with bending 
mode contamination. The signal was first passed through 
the tracking notch filter modules and the result was then 
used as an input to the two channels of the bending mode 
frequency determination, tracking and filtering algorithm. 
The unusual process of passing the input signal through the 
uh filters first was done to allow the effects of feed- 
back to be observed as the notch filters remove the very 
signals that the remainder of the T E ISC ADO το 
Brack. 

süre 3-19 shows the two-hertz input signal (line 3) 
mne notch filters and the resulting output signal (line 
2, accentuated). The notch filters were reasonably able 


to filter out the 6 and 10 hertz components and pass the 
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ООО ТЕ. The numerical data associated with Figure 3-19 
ites an average phase loss of 18 degrees was experienced 
over the 2 seconds of simulation. 

Eure 5-20 shows the tracking history of each of the 
wels. The low channel locked on the six-hertz frequency 
EDUC lock on frequency was 6.0546 Hz) after 0.56 seconds 
and remained locked on for the remainder of the simulation. 
Me high channel went into a four cycle per second limit 
cycle with an average frequency of 9.85 hertz. The cause 
of the limit cycle is leadage of the two-hertz signal when 
the amplitude of the two-hertz reaches near maximum ampli- 
Es The limit cycle has a minimum effect on the output 
of the notch filters since the high channel notch bandwidth 
is nearly six-hertz and the magnitude of the limit cycle 
monly 1.65 hertz. 

Eu ure 5-21 shows the input (line I) and output (line 2, 
accentuated) of the low frequency channel bandpass filter. 
Figure 3-22 shows the input (line 1) and the output (line 2, 
accentuated) of the high channel bandpass filter. The effects 
of the leadage of the two-hertz signal can be seen in the 


Dut of both filters. 
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DZ SW EATION STUDIES 


Pee DIGITAL SIMULATION LANGUAGE (DSL/360) 

The programming languages used throughout this thesis are 
ehe IBM Digital Simulation Language (DSL/360) [9] and FORTRAN 
IV. DSL/360 has not been released for general use by the IBM 
Serporation but was used in this thesis for the simulation 
studies due to its enhanced capabilities. The exclusive 
res of DSL/360 were used only in modeling of the con- 
ΠΠ systems. The modules of the adaptive digital filter 
are programmed exclusively in FORTRAN IV and may be used with 
any continuous systems simulation language that will accept 


FORTRAN subroutines. 


B. BLOCK DIAGRAM OF THE SIMULATION MODEL 

Figure 4-1 illustrates the block diagram of the system 
Meea to develop Program 4-2. The block diagram forms the 
Bore program for all the simulation studies in this chapter 
With the only changes being the addition of a ramp function 
for the input command in Program 4-3 and ramp functions to 


Encsgte dynamic bending mode frequencies in Programs 4-10 and 


212, 


STIMULATION CONDITIONS 
me parameters of the plant selected for all the following 


migration studies are from Table 2-1 at time = 40 seconds. 
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The selected plant parameters represent the values when the 
missile passes through the point of maximum dynamic pres- 
ure max Q) and is the least Stable even without the pre- 
sence of bending modes. When simulation studies were 
conducted with plant parameters yielding a more stable plant 
me results indicated the proposed adaptive digital filter- 
ing technique functioned essentially the same and therefore 
only the worst case conditions are presented. 

Two pitch commands from the guidance system were selected 
EN mulation: a 0.1 radian Step input and a 0.05 radian 
per second ramp. The step command simulates a command from 
the autopilot which would normally occur at water exit, 
пс, or inflight restart of the guidance system after a 
failure. The simulation studies with a step input are in- 
tended to simulate the condition of a guidance system 
Ert at the point in the flight when the missile has the 
east Stability, a highly unlikely but undoubtably severe 
condition. The ramp input simulates a more normal condition 
Mere the autopilot responds to wind shear at the point of 
Eust Stability. The ramp input response serves to demon- 
Strate that although the bending modes are not excited as 
violently as they are with a step input, the adaptive digital 
filters successfully detect their presence and provide the 
proper filtering. The ramp input again includes the simu- 


lation of an inflight restart of the guidance system since 


ШО 





ШӘ simulation is started with no history available to the 
meeptive digital filters or frequency detector algorithms. 

The bending mode frequencies were the primary variable 
mathe Simulation studies. The first two studies have fixed 
memaing mode frequencies centered at 6.0 and 10.0 hertz. 
The third study has the bending mode frequencies again fixed 
Mt 7.0 and 9.0 hertz to ensure that the algorithm can 
separate two close bending mode frequencies. The fourth 
Emly has the bending modes fixed at 5.5 and 14.0 hertz to 
ET the ability of the algorithm to properly filter two 
Widely separated bending mode frequencies. The final two 
Studies have dynamic bending modes with the upper bending 
mode changing at the rate of 1.5 hertz per second and the 
lower bending mode changing at 1.0 hertz per second. The 
mates Of change far exceed the rates of change anticipated 
i were included as a demonstration of the capability of 
Bsalcorithm to track very high rates of change in the 
bending mode frequencies. The final two studies illustrate 
the response of the system with the bending mode frequencies 
converging and diverging. 

Table 4-1 provides a summary of the conditions used in 


EE Six Simulation studies. 


IAS TMULATION RESULTS 
Figures 4-2 and 4-3 illustrate the system response for a 
U.1 radian step pitch command with the bending mode fre- 


 ЕПсіевс fixed at 6.0 and 10.0 Hz. Line 1 in Figure 4-2 is 
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TABLE 4-1 








FIGURES INPUT BENDING MODES 
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4-9 STEP FIXED 
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4-11 STEP DYNAMIC 
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Figure 4-2 Missile Step Response with Fixed 6 and 
10 Hz Bending Modes 
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the nominal response of the plant without bending modes to 
the same input. It is provided as a standard by which the 
effectiveness of the adaptive disital notch filtering may 

be evaluated. Line 2 in Figure 4-2 is the response of the 
system with the bending modes and the adaptive digital notch 
filters. 

cure 4-3 provides a history of the center frequency of 
hich and low channel notch filters. Line 1 is the his- 
ОТ тһе low channel (5.0-8.0 Hz) notch center frequency 
and Line 2 is the history of the high channel (8.0-12.0 Hz) 
notch center frequency. Lines 3 and 4 indicate the actual 
bending mode center frequencies. 

Eure 4-2 must be compared with Figure 2-17 to gain the 
Proper perspective on the degree to which the system has been 
Emir zed by the adaptive notch filters. Figure 2-17 is 
precisely the same system and the same input except the 
adaptive digital notch filters were not in the system simu- 
Bed in Figure 2-17. The amount of leakage of the 6.0 
Eur bending mode frequency through the notch filer is due 
Ene relatively low precision coefficients used in the 
notch filters. Simulation with double precision coefficients 
reduced the leakage considerably but the implementation of 
the notch filter with this precision was not considered 
practical for implementation with a microprocessor and 


therefore not pursued. 
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sn 4-5 1ilustrates that the algorithim can rapidly and 
Mecurately track the 6.0 hertz bending mode frequency but 
exhibits limit cycle behavior when tracking the 10.0 hertz 
Mending mode. The limit cycle behavior can be attributed to 
the low frequencies associated with the plant dynamics causing 
ors in the frequency detector as discussed in Chapter 
Three. The limit cycle does not appear to diminish the high 
Channel's effectiveness in eliminating the 10.0 Hz bending 
mode in that there is no evidence of the 10.0 hertz bending 
mode in the output and it is attenuated to the point that the 
frequency detector can no longer track it after 1.5 seconds. 

Figures 4-4 and 4-5 show the response of the system for 
a 0.05*T ramp pitch command with bending modes centered at 
anda 10.0 hertz. Comparing Figure 4-4 with Figure 2-23 
it is evident that when the adaptive digital notch filters 
gee included in the system the response is essentially the 
same as if no bending modes were present. Figure 4-5 shows 
ehe ability of the high channel to much more accurately lock 
onto the 10.0 hertz bending mode when the high plant rates 
ιο present. The very satisfactory performance for a 
ED Input indicated that this input did not stress the 
lity of the adaptive digital notch filter algorithm and 
it was therefore not used in the remainder of the simulation 
studies. 

Figures 4-6 and 4-7 show the response of the system for 


a 0.1 radian step input when the bending mode frequencies 


107 





БЕРЕСІ 
Angle 
ЕШ Rad. 


-0.03 -0.02 -0.01 
ee 


"ο. Ου 


-0.0% 


e کا یا ا‎ epe, =a 





0.06 
DN EP pe 


-0.07 


AE dÊ 











PASOS TE er | E : 
9.00 0.20 0.40 0.50 0.80 1.99 1.20 i 0 1 50 :.ай 2.00 


Time, Sec. 


System; Third order missile model with fixed 
bending modes at 6 and 10 Hz 


put: 0.05 radian/sec ramp command 


nce lS the nominal missile response without 
bending modes 


nca msmrhesmussilecresponse with bending modes 


Figure 4-4 Missile Ramp Response with Fixed 6 and 10 Hz 


Bending Modes 


108 





Incequency 
ο 


15.00 


13.00 14.00 
ED => 


Actual Bending Mode Frequency 


High Channel Detected 
Ioco me 


_ГАГ\ гү 


Li 7 f 


11.00 12.00 


10.00 





8.00 


е е_——=“{ 


8.00 


Low Channel Detected Frequency 


7.00 
L: 





LJ 


6.00 


Actual Bending Mode Frequency 


.00 





Time, Sec. 


eure 4-5 Frequency Detector Output for Fixed 


6 and 10 Hz Bending Modes 


109 





-0.01 0.00 6.6 


De 


-0.05 


Pitch 
le . 
© 5 Ваа. o4 








O προ Soe eae P νος mc ux ME ==; 
'0.00 0.20 0.49 0.50 0.90 1 00 1.20 1.40 1.60 1.80 2.00 


Time, Sec. 


System: Third order missile model with fixed 
bending modes at 7 and 9 Hz 


Input 0.1 radian step command 


Line 1 is the nominal missile response without 
bending modes 


Line 2 TS thE MISS11€ Tesponsée with bending modes 


Figure 4-6 Missile Step Response for Fixed 7 and 
9 Hz Bending Modes 


110 





meecguency 
Hz 


15.00 


14.00 


33.00 


ΠΗ ΓΗ ИС ee TeECTED FREQUENCY 


| 
ACTUAL BENDING MODE FREQUENCY 
| 


| 

| 

' n 
" A Af 

5 CHANNEL DETECTED FREQUENCY 


ы ы == = me E 


ACTUAL BENDING MODE FREQUENCY 











ШЕШСЕ 2-0 Етвапепсу Betector Output for Fixed 


7 and 9 Hz Bending Modes 


ΠΠ 





mere fixed and only separated by 2.0 hertz. The system 
response is very close to the nominal plant with some evi- 
dence of both bending modes present in the output. The 
cross channel leakage can be seen to cause oscillations in 
een Of the frequency detectors. 

Figures 4-8 and 4-9 show the response of the system to 
EN Ui radian step input with the bending modes separated by 
7.5 hertz. The lower frequency bending mode is at ΕΠ hertz 
EN 5 hertz above the lower limit to which the algorithm 
is allowed to track and the upper frequencv bending mode is 
ШОШ етс. The upper bending mode frequency is outside of 
the passband for the high channel frequency detector but 
within the 15.0 hertz that the high channel is allowed to 
E s mode, The performance of the system is 
marginal at best. This simulation clearly illustrates the 
wel ty of the algorithm to reliably acquire or track a 
Memaing mode higher than 12.0 hertz. The problem is not 
ΝΠ... αιεὰ by the bandpass filter in the high channel 
attenuating frequencies above 12.0 hertz. Increasing the 
memewrdth of the high channel to 15.0 hertz did not enhance 
the ability of the algorithm to reliably identify a fre- 
πο above 12.0 hertz. 

meres 4-10 and 4-11 show the system response for a 0.1 
radian step input with dynamic, converging bending mode 
frequencies. The high frequency bending mode starts at 12.0 


Metz and decreases at 1.5 hertz per second to 9.0 hertz. 
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The low frequency bending mode starts at 6.0 hertz and іп- 
@eeases at 1.0 hertz per second to 8.0 hertz. The ability 
Ehe adaptive digital notch filters to stabilize the system 
with such high rates of change was not expected. When 

higher rates of change were simulated for the converging 
case, the error in the high frequencv estimate became so poor 
that the system became unstable at the frequency of the high 
bending mode. A rate of 1.5 hertz per second is felt to be 
the limit on the rate of change of either bending mode fre- 
quency. 

Figures 4-12 and 4-13 show the system response to а 0.1 
radian step input with dynamic diverging bending mode fre- 
quencies. The upper bending mode frequency starts at 9.0 
hertz and increases at the rate of 1.5 hertz per second to 
12.0 hertz. The lower frequency bending mode starts at 8.0 
hertz and decreases at the rate of 1.0 hertz per second to 
6.0 hertz. The very good performance of the system is pro- 
Baby due to the notch filters being initialized at 8.0 
ES The inability of the high channel to track a bending 
mode frequency greater than 12.0 hertz is evident as the 


high bending mode frequency increases. 
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V. CONCLUSIONS AND RECOMMENDATIONS 


Pee CONCLUSIONS 

The feasibility of implementing an adaptive digital notch 
filter to stabilize the Trident Missile Control System when 
two dynamic bending modes are present has been demonstrated. 
The conditions simulated in Chapter Four represent the worst 
misc conditions and the performance of the algorithm under 
these conditions was satisfactory considering the very de- 
sirable response to less violent and more likely commands 
as shown in Figure 4-4. 

The algorithms used in the simulation studies contained 
in Chapter Four were developed with the ability to implement 
them in a microprocessor program as a primary concern.  Sim- 
plicity of the algorithm was maintained, perhaps at the 
expense of performance, to ensure that the algorithm could 
be implemented on a microprocessor for subsequent real-time 
studies. The time varying, nonlinear characteristics of the 
System when the adaptive digital notch filters are tracking 
dynamic bending modes with varying input commands deny an 
analytical approach and therefore require extensive simula- 


mone to Optimize the algorithm. 
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B. RECOMMENDATIONS FOR FURTHER STUDIES 

The simplicity of the digital bandpass filters allows an 
excessive amount of out of band interference. The perfor- 
mance of the bandpass filters could be significantly improved 
Mout an appreciable increase in the order of the filters 
wusing more sophisticated types of filters such as a 
Chebyshev or an elliptical filter. The temptation to enhance 
the performance of the bandpass filter in nonreal-time simu- 
lations without considering the implementation problem on a 
microprocessor must be resisted. 

The direct realization of the bandpass and notch digital 
filters did not minimize memory, noise due to finite pre- 
eision coefficients or the number of multiplications required 
{Or each output. The structure of the filters needs to be 
examined with a specific microprocessor's capabilities con- 
Altered. The ZILOG Z-8000 microprocessor capabilities were 
 Шетастесй during the development of the algorithm as a cur- 
nt State-of-the-art microprocessor. 

The algorithm must be evaluated on the six degree of 
freedom model of the Trident Missile available at Lockheed 
Missile and Space Company, Sunnyvale, California. The 
Butts of the simulation studies contained in Chapter Four 
are only as valid as the assumptions made in modeling the 
bending modes and in simplifying the plant. It must be 
emphasized that the algorithm contained in this thesis will 


not perform satisfactorily with the bending mode frequencies 
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Encsent in the current Trident Missile. The algorithm in 
this thesis was designed to identify, track and attenuate 
bending modes that are a full octave below those of the 
current Trident Missile. 

A phaselock loop scheme should be reconsidered as a 
frequency detector. The phaselock loop has precisely the 
desired characteristic of seeking out and locking onto a 
frequency within its predetermined acquisition range and 
seems ideally suited for the task of identifying and track- 
ing the bending mode frequencies. It is recommended that 
EFC studres of the application of phaselock loops in 
Eus application use actual phaselock loops rather than com- 
Euer Simulation due to the inability to properly simulate 
the non linear behavior of the phaselock loop with algorithms 
known to the author. Тһе feasibility of prefiltering the 
input to the phaselock loop with a bandpass filter to atten- 
ου of track range signals and thereby reduce the lock- 


on time should be considered. 
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